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ABSTRACT 


Velocity planning is one of the core functionalities of an autonomous driving system. This involves determining velocity 
at every instant of time for smooth and continuous motion of the autonomous system along a given path. In this paper an 
analytical method based on most employed trapezoidal velocity profile is proposed for generating velocities for a vehicle 
traveling along a predefined path. To improve comfort and to provide smooth control, s-like trapezoidal profile is 
considered employing cubic spline for the ramp-up and ramp-down portions. Depending upon various acceleration and 
velocity constraints which are derived from the road and physical systems, the trapezoidal velocity profile is either a ramp- 
up or ramp-down or ramp-up-constant-velocity or constant-velocity-ramp-down or trapezoidal profile, which is suitably 


associated with the given path. An in-depth analysis of the proposed method along with constraints comes from practical 


driving consideration and the results are presented in this paper. 
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INTRODUCTION 


Autonomous driving has been predicted to dramatically enhance driving safety, increase transportation efficiency 
and revolutionize the entire automobile industry, where particularly self-driving cars can offer tremendous benefits 
to both individuals and societies [1]. With the help of the on-board technologies, self-driving cars can perform real- 
time driving tasks without any input from a human operator by creating an image of the surroundings to facilitate 
traffic navigation [1, 2]. Apart from basic navigation, self-driving vehicles offer increased road safety, and may 
unclog road traffic due to their ability to communicate with each other, thereby optimizing vehicular routes and 
thus, resulting in smooth and efficient traffic flow. This, in turn, results in decreased fuel consumption, hence, 
paving the way for a more sustainable future [3, 4]. For the plethora of advantages these vehicles offer, they have 
been subjected to intense research, and thus, have become a definite reality that may pave the way for future 


systems, where robots take over the art of driving [3, 4]. 


To achieve human-like capabilities while driving, autonomous driving cars rely on path planning, this is 
the “brain” of the entire system. Path planning and decision making in urban environments enable self-driving cars 
to discover the safest, most convenient, and most economical routes from source to destination [5, 6]. This sub- 
system is capable of reproducing the human thought-process involved while driving - route planning based on the 
source and destination, real-time analysis of the surroundings and maneuvering any encountered obstacles, and at 
the same time adhering to traffic rules and maintaining a safe and optimal trajectory [7, 8]. As autonomous on-road 
driving require path, manoeuvre and trajectory planning, the planning algorithm includes the search for an optimal 


collision-free path adhering to the feasible configurations implicated by path planning, characterization of motion 





www.Upre.org editor @Ujprc.org 


2 Hrishikesh Dey & Rithika Ranadive 


indicated by manoeuvre planning, and real-time constraints while transitioning from one feasible state to another as 


directed by trajectory planning [9 - 11]. 


The path planning algorithm includes the search for a feasible path by taking into consideration the dimensions of 
the vehicle, the geometry of its surroundings, and the various kinematical path constraints [9, 12]. The vehicle’s movement 
is calculated so as to fulfill the car’s kinematic constraints based on its initial and final dynamic configurations. The vehicle 
must identify and bypass all the static and maneuverable obstacles to find a collision-free route. Following the path 
planner’s generation of a route through the road network, the man oeuvre/motion planner evaluates the surrounding 
environment and produces the most appropriate motion specification for the trip. The most suitable path is obtained using a 
trajectory planning algorithm which refers to the creation of a collision free path from the initial point to the destination 
point. The objective of trajectory planning is to search for the optimal motion of a vehicle subject to obstacle fields and 
vehicle motion constraints. In order to generate the real-time trajectories, a reference path (base frame) is extracted 
mathematically considering various path constraints such as restrictions on size of vehicle with respect to the road, and 
restrictions on vehicular drive. Using this base frame as a reference, a rich set of possible paths (candidate frames) for a 
given source and destination will be generated kinematically. Each path generated is then associated with one or many 
velocity profiles. The most feasible candidate is then selected based on the criteria of collision avoidance with both static 
and dynamic obstacles, vehicle constraints and smooth driving. Motion planning highlights various critical challenges in 
the development of the autonomous driving systems, including velocity planning. Velocity planning, defined as the 
variation in velocity along a predefined path for the motion control of autonomous vehicles, becomes very complex due to 
continuously changing environments [13, 14]. Therefore, the velocity profile needs to be carefully assigned on each point 
along the generated path. By considering both path planning and motion planning constraints, a velocity profile is 
employed that can optimize driving capability, while adhering to the behavior and velocity limits of the vehicles in a 


driving scenario, and at the same time avoids collision completely [15]. 


In recent years, a significant amount of work has been dedicated to achieve fast and efficient motion planning 
algorithms, as it remains one of the most important aspects of autonomous driving. Aurelio Piazzi in [2] proposed a 
solution that includes designing a longitudinal velocity profile incorporating cubic splines and an ad hoc algorithm with a 
minimum jerk, eventually accomplishing the creation of continuous velocities and accelerations. As demonstrated by 
Xiaohui Li in [16], the velocity profile generation is initiated by the determination of maximum permitted speed by the 
behavioural planner, the model constructs the trapezoidal speed curve, followed by the application of polynomial splines to 
ensure continuous acceleration. The formal proof to produce an optimal velocity profile, for least time travel, has been 
suggested in [17] by overcoming the loss of controllability that occurred in previous literature providing faster computation 
along with the ease of implementation. Keonyup Chu in [1] described a collision risk procedure to determine target speed 
by limiting the value of lateral acceleration as maintained by the curvature of the path. Jordi P’erezTalamino and Alberto 
Sanfeliu’s method in [13] imposed initial and final acceleration restrictions to compute the profiles using third order 
velocity splines in four unknown variables, considering the fifth unknown to be the total time required to travel the given 
trajectory. The latest development by I. Bae in [18] planned an Occupant’s Preference Metric (OPM) which described a 


lateral and longitudinal acceleration section with the highest permissible jerk. 


Autonomous vehicles should be capable of assigning appropriate velocity profiles for a selected optimal path. 


Velocity planning is a versatile and effective tool for the motion control of autonomous vehicles. The planning 
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optimization algorithm should offer an efficient method for the evaluation of minimum pure-jerk velocity functions. To 
ensure smooth driving, a velocity planner uses semantic information given by the path planner to establish a continuous 
velocity profile that considers acceleration and speed thresholds within the selected optimal path (trajectory) [19]. This 
paper provides an overview to achieve generation of suitable velocity profiles for an optimal trajectory, explicitly 
considering various velocity, acceleration, path and time constraints. Considering these constraints help reduce the solution 
set of the velocity planning, resulting in the planner to focus on the solution space where the optimal solution is more likely 
to exist. The trapezoidal velocity profile 1s considered as a reference to generate a stable velocity profile fulfilling various 
constraints and mode of travel such as velocity-keeping, following, stopping etc. as suggested by higher order behavioral 
module. Finally, to obtain smooth and jerk free motion the generated velocity profile is replaced with high order 


polynomial spline curve maintaining all constraints. 
Specifically, the main contributions of this paper are: 


e An approach for accurately generating suitable velocity profiles by employing trapezoidal velocity curve for 


anoptimal trajectory, explicitly considering various velocity, acceleration, path and time constraints. 


e Demonstration of different jerk minimization techniques involving generation of smooth s-curve motion profiles 
with low associated accelerations, incorporating high order polynomial spline equations with the suitably 


generated trapezoidal velocity profile sequences for the optimal trajectory. 


e An experimental validation and evaluation of the special test case where velocity and time constraints are altered 


to generate the suitable motion profile. 
RELATED WORK 


Over the last decade, there are ongoing efforts to deploy driver-less cars in realistic urban scenarios. This section deals with 
the assessment of various complex techniques that have been produced for the accurate generation of optimal trajectories 
and implementation of motion profiles for the development of autonomous vehicles. Previous research has attempted to 
reduce jerks in autonomous vehicles by applying various smooth velocity profiles, such as the s-curve jerk-bounded 
profile. High-order polynomial motion profiles enable the vehicle to move smoothly. The increase in the order of a 
polynomial equation results in an equivalent increase in the number of coefficients for the function of time, resulting in the 
generation of smoother shapes of position and velocity profiles. Abhiram Rahatgaonkar’s thesis on Velocity Planning 
Approach for Autonomous Vehicles [20] concentrates on velocity planning with familiar environment to avoid collision 
with moving obstacles. This technique involves time scheduling in space along with A* search algorithm to optimize the 
generated profile. The specified analysis promises to extend towards greater driving scenarios including merging and lane 
intersection. Further research in [21] asserted a practice involving the calculation of minimum velocity for the entire 
trajectory to construct a smooth transition profile, from the minimum to the maximum allowed speed, fulfilling 
acceleration and jerk restraints. Robust Motion Predictive Control (RMPC) design methodology presents a system capable 
of handling both ordinary and rare driving scenarios. This approach recommends considering the velocity and acceleration 
constraints of the preceding vehicle as instantaneous checks instead of constant values for the entire trajectory to be 
followed. It calculates the relative velocity and distance at every time instant for generating acceleration sequence adhering 


to the collision avoidance ability. The safety constraints applied to the vehicle are actuator limit, speed limit and safe 
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following distance. Thus, Francesco Borrelli in [22] achieved significant accuracy and safety control through his proposed 


framework. 


Zvi Shiller in [23] achieves a path planning algorithm for vehicles moving on a general terrain and accounts for 
obstacles, terrain topography, vehicle kinematics and dynamics. The terrain and the path are illustrated by B spline patches 
and curves. This method determines the most feasible path requiring minimum time and adhering to vehicle kinematics, the 
engine torque limit and the given coefficient of friction. The mathematical derivation of the desired torque or velocity 
signals that act as an input to the respective torque or speed controllers is provided by Martin Adams in [24]. In addition to 
that, it also defined a trajectory generator which produced constant jerk profiles in acceleration, velocity and displacement, 
while maintaining vehicular constraints of acceleration and velocity. Seiji Sugiyama in [25] proposed a method by 
applying an ellipse field, which is obtained by using the conformal transformation, and a correction function, which 
generates the continuous velocity field, to an already existing Hydrodynamic Potential method for path planning of a 
mobile robot. The system when applied to arbitrarily moving obstacles, showed results with reduced velocity variation. 
Cheng Chen in [26] devised a solution to counter the problem of trajectory generation by producing continuous and 
bounded curvature profile to outline the trajectory, further optimized by the quartic B’ezier curve. The structure of linear 
velocity profile generation has also been proposed to avoid sideslip, and establish velocity—continuity and acceleration 
limits. An algorithm of computational complexity O(n) has been used by L. Consolini in [27] to provide a time-optimal 
velocity planning technique for autonomous vehicles. Not only does this planning take into account the usual kinematic 


constraints, but also sets a bound on the vehicle’s maximum normal acceleration which aids in avoiding dangerous slips. 
VELOCITY PLANNING FORMULATION 


We designed and implemented an efficient real-time approach for velocity planning of a known optimal trajectory within 
specified constraints as shown in Algorithm 1. The required velocity and acceleration constraints can be 


calculated/modified such that the trapezoidal velocity profile modifies to a linear or a ramp velocity profile. 


Algorithm 1: Generating Motion Profiles for an Optimal Trajectory 


for each optimal trajectory do 
divide the trajectory into several minuscule paths for assigning velocity 
profile; 





end 
for each minuscule path do 
consider various velocity, acceleration and path constraints; 
consider time limiting constraint 7}. for constant velocity region; 
generate the trapezoidal velocity profile; 
end 
for each generated velocity profile do 
calculate time required to cover a given length on the minuscule path 
using newton-raphson method; 
use the above estimated time for numerical analysis of high-order 
polynomials; 
generate smooth s-curve motion, position and acceleration profile; 
end 
Result: trapezoidal velocity profile, smooth third-order s-curve motion profile 


Velocity Profile to be assigned for the minuscule paths 





Selected Optimal Trajectory 


Figure 1: The Division of Selected Optimal Trajectory into Minuscule Paths for Assigning Velocity Profile 
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Assumptions. Considering the velocity (initial velocity V,, maximum velocity V,,and end velocity V.) and 
acceleration (initial acceleration A and deceleration D) constraints, a velocity profile can be designed for a selected optimal 


trajectory(Total path length S). 


Algorithm Phase 1. The initial procedure involves the generation of a speed curve by employing the trapezoidal 
velocity profile. Instead of generating the velocity profile for the entire path length S, we divide the trajectory into several 
minuscule paths of length s to obtain the best fitting curve as illustrated in Figure 1. The instantaneous changes in velocity 


demand the constraints to differ for every minuscule path length s. 


Algorithm Phase 2. The initial velocity V, for the first segment is established in advance by the planner. The 
maximum velocity V;, remains constant for the given minuscule path and restricts the vehicle from exceeding the range. 
We introducea new constraint, the limiting constant, 7;, which is the least time for which the vehicle is expected to travel at 
a constant maximum velocity to avoid collisions and maintain stability. The final velocity V.is dynamically dependent on 
the velocity of the leading vehicle to ensure collision free driving. As shown in Figure 2, the trapezoidal motion profile is 
applied for the velocity profile generation. We assume the ramp-up and ramp-down profiles with constant acceleration and 
deceleration values to attain a solution. The velocity profile consists of three sections: (1) the initial ramp-up slope T; / S$; 
from the initial velocity V, till the maximum velocity V,, ; (2) constant traversal segment T> / $2 at the maximum velocity 
Vn 3; (3) the ramp-down slope T3 / $3 from the maximum velocity V,, till the final velocity V. . The equations for distance 
covered by the three sections S;, Sz and $3 have been formulated using Newton’s Laws of Motion. The consecutive 


minuscule path segments obtain the final velocity V. of the previous set and set it as its initial velocity Vo. 
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Figure 2: Trapezoidal Velocity Profiles Showing Different Segments. 


www.Uprec.org editor @Ujprc.org 


6 Hrishikesh Dey & Rithika Ranadive 


Vm = 20 m/s 


Velocity (m/s) 








Vo=0 m/s Ve=0m/s 


0) 3 6 9 
Time (sec) 


Figure 3: Trapezoidal Velocity Profile Considering 7; to vary from 0 to 5 seconds. 
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The total distance of the minuscule path s in Equation 4 for which the velocity profile has been generated, is equal 
to the sum of the distance covered by three segments of the profile as specified in Equations 1, 2 and 3. Considering the 
total path length to remain constant, and acceleration and deceleration to be A and D respectively, the time fs2 for traveling 


the segment S> is estimated in Equation 5. 


The velocity profile generated in Figure 3 is a special case as it does not trace a zero-acceleration region when T, 
= 0. The abrupt change from acceleration to deceleration results in a jerky motion. Thus, to ensure a smooth motion, a new 
value of maximum velocity, labeled new Vn, replaces V,;, while plotting the velocity curve. For this purpose, we have 
defined a constant 7; , which serves as a time limiting constant and fulfils the need to generate a non-jerky and smooth 
velocity profile for all sets of inputs. The constant, 7;, is the least time for which the vehicle is expected to travel at a 
constant velocity V;, to avoid collisions and maintain stability. If the calculated time ts2 in Equation 5 is greater than or 
equal to 7;, there is no change in the value of V,, as the time stability criterion is already obeyed. However, in cases where 
the estimated time fs2 turns out to be lesser than Ti, new V, is calculated using a quadratic formula as mentioned in 
Equation 6. The equation for new V,, is formulated by utilizing Equation 4. The time required for covering the segment S> 
is considered as 7; and the entire equation is reconstructed to form a quadratic equation with the variable V,,. This is 
achieved by allowing the vehicle to travel the same distance in increased time duration for a stable journey. The value of 


new Vi 1S estimated by considering the minuscule path length s to be constant and the time fs2 in Equation 5 to be time 


limiting constant, 7;. 


On comparing Equation 6 to the standard quadratic equation ax’?+ bx + c, thereby fulfilling the condition b?-4ac> 


0, obtains two roots as the value of new V,,. Between the roots obtained, the greater positive value of the two is selected as 
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the new V,,. Depending on the values of the constraints, the velocity profile curve chooses to fit (Si, $2, $3) 7 (T1, 
T>,T3)individually, or a combination of these three segments. On the contrary, if the condition b’-4 acbecomes negative, no 
solution is obtained for the given set of the velocity profile. Figure 3 shows that the value of 7; when set to zero, results in 
no alteration in the value of V,, as time ts2 evaluated for segment Sz is equal or greater than the value of 7). However, 
when 7; is set to a higher value, then the value of the maximum velocity V,, alters itself to a lower value of new Vn to 
adhere to the vehicle constraints. As a result, anon-smooth trapezoidal velocity profile curve is established, limited by the 


vehicle and path constraints. 


Algorithm Phase 3. The trapezoidal velocity profile is further smoothened to guarantee the continuity of the 
acceleration and optimize comfort by providing minimum jerk. Parameterization of the velocity profile is achieved by 
interpolating cubic polynomials. The ramp-up and ramp-down processes of the trapezoidal velocity profile are smoothened 


individually using cubic order spline equations, considering the most suitable runtime during computation. 
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The cubic expression for velocity v(t)at any given time ¢ is defined in Equation 7. The time taken to cover the 
ramp-up and ramp-down segments will be different in the s-curve profile as compared to the trapezoidal velocity curve. To 
smoothen these segments in the s-curve, the total time tf equired by each segment is calculated. The expression for velocity 
at ty, can be derived using Equation 7 and it is expressed in Equation 9. The equation for acceleration at t , 1.e. acc(t,)is 
derived in Equation 10, using the first derivative of the velocity expression Equation 9. The equation for path length at ¢, 
1.e. S(t7 is derived in Equation 11, by integrating the velocity expression Equation 9. Given the initial velocity V, and initial 
acceleration d , the unknown parameters {a), a2, a3,t; } in Equation 11 could be analytically solved with the help of 


Equations 7, 8, 9, 10 and 11. 


The equation for t 1s obtained in Equation 12, where vp is the initial velocity, vy is the terminal speed, do is the 
initial acceleration and a; is the terminal acceleration. From Equation 12, two values of t; are obtained. The most suitable 
value among the two is obtained and fis selected separately for ramp-up and ramp-down segments. These segments are 
smoothened separately for all values of t from 0 -t in the velocity v/s time s-curve profile. Similarly, sy is calculated 


separately for the two segments using Equation 11. After the value for t7 has been determined, v(t), acc(t)and s(t)have to 
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Figure 4: Cubic s-Curve Velocity Profiles Showing Different Segments 
be calculated in order to obtain the respective profiles. The equation for unknown parameters a2 and a3 can be methodically 
solved using Equations 7, 8, 9, 10 and 11, and are obtained in Equation 13 and 14, respectively. After the unknown 
parameters {d), a2, a3, t¢ } have been calculated and t has been determined separately for ramp-up and ramp-down 
segments, v(t), acc(t)and s(t)can be calculated for all values from O -t; using Equations 9, 10 and 11. With the help of 
Equations 9, 10 and 11, the velocity, acceleration and distance s-curve profiles (plots) are obtained for all values from 0 -t 


and thus, the profiles obtained are smoothened with the help of polynomial equations. 


Newton—R aphson method, a root-finding algorithm that produces successively better approximations to the roots 
(or zeroes) of a real-valued function is used for calculating the value of t7. The standard version of this method starts with a 
single-variable function f [s(t;)/defined for a real variable t; , the function’s derivative f’ , and an initial guess for a root of 
f. The value for the initial guess to is calculated by a pre-defined function which when given an input s, returns the time 
needed to cover s distance. On considering that the function is able to satisfy necessary presumptions and the initial guess 
is very close, then the process mentioned below is repeated until an adequately accurate value is attained. 


f (tn) 
tnei~ ty + (2) (15) 


The value of tis evaluated at every point on the trajectory, which is further employed to generate acceleration- 
continuous velocity profiles. As shown in Figure 4, the S-shaped ramp-up and ramp-down velocity profiles are solved 
individually. Conclusively, trajectories are generated by incorporating the spatial path with the corresponding velocity 


profiles. 
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RESULTS AND DISCUSSION 
A. Experimental Setup 

For simulating results and experimental evaluation, the entire programming code was developed using Integrated 
Development Environment (IDE) 1.e., Visual Studio with the help of Object-Oriented Programming Methodology in C++ 
programming language. The plots of various motion profiles were generated and verified using Gnuplot and MATLAB. 
The entire programming code has been developed and structured exclusively, taking velocity, acceleration, time, and path 
constraints as inputs, and generating the desired velocity profile as output. To generate various motion profiles, the final 
deceleration i.e., acceleration at end velocity V. has been considered as Om/s’. The limits of the initial acceleration A and 
the initial deceleration D are based on the vehicle, and traffic rules which are pre-decided and taken as 5m/s* and -5m/s?, 


respectively. 
B. Generating various Velocity Profiles 


One of the most important aspects involved in autonomous driving is the velocity profile generation. Velocity planning has 
a great impact on safe driving and comfort of vehicles, especially in realistic urban circumstances. Therefore, the velocity 
profile must be assigned carefully on each point along the trajectory. The total length of the given trajectory (path) S was 
divided into several minuscule paths each having a distance s for which the velocity profiles were generated, considering 
various path constraints. The path constraints such as the maximum allowed speed V,,, the acceleration (acceleration A and 
deceleration D), the velocity (initial velocity V, and end velocity V.) and the total distance of the minuscule path s dictated 
by the path were compulsorily fulfilled to obtain the desired velocity profile. Depending upon the applied constraints, the 
trapezoidal, linear, or ramp velocity profiles were generated. As the ramp and linear velocity profiles are components of the 
trapezoidal velocity profile, they help in evaluating the results for the same. The linear profile is generated in a situation 
when the vehicle, which is moving atits maximum velocity, decelerates to lower terminal velocity. Similarly, the ramp 
velocity profile is obeyed when the vehicle needs to attain an end velocity, which corresponds to its maximum speed. In 
addition to that, it can also trace the linear or ramp profile consisting of the only segment, $7, or S3 respectively, when the 


value of the path length is insufficient to incorporate two segments. 


To verify the different types of motion profiles, velocity v/s time and velocity v/s distance (position) profiles are 
obtained. In the velocity v/s time profile, the velocity for every given point (time) ¢, lying on the total time taken to cover 
the minuscule path 7, has been calculated. Similarly, in the velocity v/s distance profile, the velocity for every given 
point(distance) p, lying on the total distance of the minuscule paths, has been calculated. The velocity v/s time and velocity 
v/s distance profile comprise three segments namely, the ramp-up slope 77 / S;, the constant traversal segment T> / $2, and 
the ramp-down slope T3 / $3. On altering the values of the velocity constraints, the velocity curve decides to fit $7, S2,S3 / 
T1,T2,T3 individually, or a combination of these three segments to generate trapezoidal, linear or ramp velocity profile. 
Table I shows the estimated values of velocity constraints to generate different types of motion profiles. The total distance 
of the minuscule path s for which the velocity profile has been generated is equivalent to the sum of the distance covered 
by three segments of the profile. The path constraint s 1s considered as 150m. The distance, time, velocity, and acceleration 
equations required for the generation of various types of velocity profiles have been formulated using Newton’s Laws of 
motion. The equations for S;, S2 and S3 are necessary to calculate the distance covered by each segment in a velocity v/s 


distance profile. 
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Vi= |Vp2 +(2 XAXp) (16) 


V2= Vin (17) 
Vi= |Um? + (2 XD Xx @-(S, + 52) (18) 
T) =" (19) 

To = ts2 (20) 
T;=“™ (21) 
Vi=V,+(AXt) (22) 
V2 = Vin (23) 
V3=Vy,+(D xX (t-— (1, + T2))) (24) 


Table 1: Velocity, Time and Distance Constraints Considered for Generating Various Types of Velocity Profiles 


Velocity Profile 
PTrapezoidal 0 20) || a] 50 


fLinear | 20 | 20 S| S| 3875 | 150 
Ramp SSCS Cd Sd 20 CSSC~ Cs tO 
| Trapezoidal (no SxRegion) | 0 | 20 | O [| 0 | 40 | oO | 40 | 80 | 
| Trapezoidal (new Vsurie) | 0 [| 20 | O [| 6 | 10 | 60 | 10 | 80 | 





Table 2: Time Taken to Cover Each Segment of Various Non-Smooth and Smooth S-curve Velocity Profile 


d 
Trapeodal || | 8 |S 3745 | 35 | 3745 | (1099 
Liner SSCS~<‘idCSCiSC*i SST BBO [0 | 56s, 3 | 8s 


pRamp | 4 5S | S349 | 5S | OF 899 
| Trapezoidal (no SxRegion) | 4 | 0 | 4 | 8 [3.745 | 0 [3.745 | 749 
| Trapezoidal (new Vsurie) | 2 | 6 | 2 | 10 | 187 | 6 | 187 | 974 | 





Using Equations 1, 2 and 3, the distance covered by each segment of the velocity v/s distance profile can be 
derived. The time fs2 , required to cover the segment S», is obtained using Equation 5. The velocity at any given point 
(distance) p lying between 0 to S;, S; to S2, and S2 to $3 on the minuscule path in a velocity v/s distance profile, can be 
calculated using Equations 16, 17 and 18 respectively. Table I shows the distance covered by each segment of the various 


generated velocity v/s distance motion profiles to the considered velocity, acceleration, path, and time constraints. 


Newton’s Laws of motion can be also used to formulate the equations in the simplest form of acceleration, 
velocity, and time constraints for 77, T>, and 73, to calculate the time taken by each segment of the velocity v/s time profile. 
Using Equations 19, 20 and 21, the time taken to cover each segment of the velocity v/s time profile can be obtained. The 
total time to travel the minuscule path s is equal to the sum of the time taken by each individual segment of the profile. The 


velocity at any given point (time) t lying between 0 to 7), T; to T2 and T2 to 73 on various velocity curves in a velocity v/s 
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time profile, can be calculated using Equations 22, 23 and 24 respectively. Table II presents the time taken by each 


segment of the various generated smooth and non- smooth velocity v/s time profiles to the considered velocity, 


acceleration, path, and time constraints. 


The non-smooth trapezoidal, linear and ramp velocity profiles w.r.t distance and time are generated in Figures 5, 6 
and 7, respectively. The velocity, acceleration, path, and time constraints have been applied to obtain each profile. To 
maintain constant velocity as the leading vehicle, the acceleration at endvelo city V. in all the profiles 1s considered to be 
Om/s’. The trapezoidal curve comprises of all the three segments i.e., S;,S2 and 53 in velocity v/s distance profile, and T), T> 
and 73 in velocity v/s time profile. The linear velocity curve does notconta in S; and 7; segments, whereas the ramp 
velocity curve does not contain S3 and 73 segments in the respective distance and time profiles. Also, the total time taken to 


cover the entire profile for a given length of minuscule path is calculated and tabulated in Table 2. 
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Figure 5: Non-Smooth and Smooth s-Curve Trapezoidal Velocity Profile 


20 






=| inear curve 
=| inear s-curve 


Nn 


_ 
-_ 
ae 


Velocity (m/s) 


Nn 


0 3 6 9 
Time (sec) 


Velocity v/s Time 


www.Upre.org editor @Ujprc.org 


12 Hrishikesh Dey & Rithika Ranadive 


20 


Wn 





eLinear curve 
ew Linear s-curve 


Velocity (m/s) 


— 
~~ 
— 


0 50 100 150 
Distance (m) 


Velocity v/s Distance 


Figure 6: Non-Smooth and Smooth S-Curve Linear Velocity Profile 
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Figure 7: Non-Smooth and Smooth s-Curve Ramp Velocity Profile. 


The above section deals with the plotting of a non-smooth velocity profile curve within the applied constraints and 
aims at generating a curve that requires the least amount of time to travel from the initial to the final position on the 
trajectory. Amongst the three types of curves obtained, the trapezoidal velocity curve is the most applicable as it guarantees 
the employment of the segment $2 which maintains the vehicle at constant maximum velocity. The ability of jerk 
avoidance of the system is furnished by 7;, which alters the maximum velocity to a lower value for maintaining stability. 


This ensures that the vehicle travels at the maximum velocity for the longest time possible hence reducing the duration of 


travel to a minimum. 
C. To Smoothen the Generated Velocity Profiles 


Following the generation of various velocity profiles is the curve smoothening, which is necessary to provide smooth 
control and jerk minimization. The time duration required to cover the ramp-up and ramp-down segments in the s-curve 


profile differ from those obtained in the trapezoidal curve profile. 
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Figure 10: Generation of a Trapezoidal Velocity Profile using newVm on Introduction of a 
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The total time t , required to cover each segment in an s-curve profile, is calculated to produce a continuous s- 
curve. In this approach, the ramp-up and ramp-down segments are smoothened individually using cubic polynomials for all 
values of t ranging from O - ¢# in the velocity v/s time s-curve profile. Similarly, the velocity v/s distance s-curve is 


generated for all values of p from 0 -sy. The generated non-smooth trapezoidal, linear, and ramp velocity profile in Figures 
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5, 6 and 7 respectively, are adopted to smoothen the curve using spline equations considering the same velocity, 
acceleration, path, and time constraints. Table II shows the variation in travel time for generated non-smooth profiles as 
opposed to the s-curve velocity profiles. Moreover, the value of t 1s used to obtain acceleration and distance s-curve 
profiles. In addition to velocity, acceleration and distance are also calculated for all values of t from O -t in each segment of 
the s-curve motion profile, thus obtaining the smoothened acceleration v/s time and distance v/s time profiles. Figures 8 
and 9 display the acceleration v/s time and distance v/s time s-curve profile for trapezoidal, linear, and ramp s-curve 


motion profiles, respectively. 


In case the time required to travel segment Sp 1.e., ts2 turns out to be lesser than the time limiting constraint T;, a 
new value of maximum velocity V,, 1s calculated, considering the given velocity, acceleration, time, and path constraints. 
Figure 10 demonstrates the purpose of the time limiting constraint, 7;. The simulation of the profiles considers the path 
constraint, 1.e., the total length of the minuscule path s, to be 80m. The velocity and time constraints applied for the 
generation of the profiles are discussed in Table I. The profile generated observing the time defining constraint, 7;, equal to 
0 seconds, is extremely unstable due to an abrupt change from an accelerating to a decelerating region, resulting in a jerky 
motion. A trapezoidal velocity profile is implemented to avoid the jerk. The trapezoidal curve is fitted for the given 
distance by calculating the new maximum velocity newV,,, lesser than the original, considering the time limiting constant, 
T;. When the value of Tis considered to be 6 seconds, the value of newV» 1s estimated to be 10m/s for generating the 
trapezoidal profile. The trapezoidal curve is then smoothened using polynomial splines to generate the respective s-curve. 
The distance traveled, and the time taken by every individual segment, viewing the time limiting constraint 7;, in the 


generated non-smooth and smooth s-curve profiles are tabulated in Tables I and II, respectively. 


In addition to this, a few exceptional cases were also reviewed during the plotting of various velocity profiles. A 
distinct case where the initial velocity was assumed to be 20m/s, the maximum velocity as 10m/s, and the end velocity as 
15m/s, traces a profile as shown in Figure 11. The values of acceleration and deceleration are considered as 5m/s’and - 
5m/s*respectively. According to the vehicular constraints, the value of maximum velocity cannot exceed the end velocity 
and thus, the graph does not trace an accelerating section. Such a situation can be encountered when the vehicle, which is 
currently travelling at a higher velocity comes across a steep curvature which constrains the vehicle to adhere to a lower 


value of the maximum velocity. 
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Figure 11: Generation of a Velocity Profile with the Absence of an Accelerating Segment when V. is Greater than 
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Figure 12: Generation of a Velocity Profile with an Additional Decelerating Segment when V-¢ is Lesser than Vin. 
Likewise, when the values of the initial, maximum and end velocity are 20m/s, 10m/sand 5m/s respectively, the 


velocity profile traces an additional decelerating section, as presented in Figure 12, as no constraints are overridden in this 


particular case. 


The generation of an acceleration continuous s-profile curve contributes in minimizing the jerk to a minimum 
value by avoiding abrupt changes in the values of velocity and acceleration during the plotting of the trapezoidal velocity 
curve. The final acceleration is assumed to be Om/sensures that the vehicle maintains a constant final velocity V.. The time 
duration necessary for travelling equal distances in the smooth and non-smooth profiles turns out to be dissimilar for the 
trapezoidal and ramp profile curves. The varying time is the outcome of the application of a steeper slope such as in S; 
region for the generation of s-profile curve as opposed to the non-smooth profile. Consequently, the interpolation of cubic 


spline curve is suitable for the velocity profile algorithm as it acquires an edge over the non-smooth curve both in terms of 


minimum time and improved stability. 
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CONCLUSIONS 


Autonomous vehicles have been extensively studied over the past decades to meet a variety of dynamic, kinematic, and 
environmental constraints. The two major aspects of autonomous driving include path planning and the velocity planning 
algorithm. This paper critically reviewed existing velocity planning approaches applied to autonomous systems and 
developed a method to produce an optimal or near-optimal solution to the problem with low computational cost. Velocity 
profile generation, an effective tool for motion control is achieved by plotting a curve for the minimum time travel of the 
vehicle through the specified path within given acceleration limits. The velocity profile ensures the safety, comfort, and 
efficiency of the system and deals with the real-time implementation for autonomous vehicles. The production of comfort 
constrained profiles for acceleration and velocity analyzes the behavior and ability of the system to generate minimum 


absolute jerk. 


Considering the various constraints applied to the system, the best fitting curve for velocity and acceleration is 
obtained while ensuring a smooth and non-jerky motion. An integration of this concept is presented which yields 
successful results in the experiments. However, it is difficult to produce a near ideal system and this approach bears its 
limitations as well. The quadratic formula dealing with the calculation of the new value of maximum velocity, newV,,, fails 
to obtain a suitable solution if no root is found. In that case, the constraints are noto beyed as a whole and need a way to be 
dealt with. In addition to this, the smoothening parameters have to be evaluated separately which increases the 
computational speed slightly. The strategy is conservative, and experiments have to be doneat various stages with a wide 
range of inputs for perfect incorporation and implementation of this method, to realistic urban driving scenarios. The 
results obtained in this paper motivate continued work in interpolating the velocity profile generation in the path planning 
and trajectory generation algorithm. Itcan also be tested on a broader range of realistic urban traffic scenarios driving at 
higher speeds to verify and evaluate its performance more sufficiently. The proposed method promises to interact and fit 


well with the existing systems and evolve with the entire autonomous driving system. 
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